#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include "sha2.h"

/*
    change hex array to string
*/
static void hex_array_to_string(uint8_t *input, int input_len, uint8_t *output)
{
    char *hexEncode = "0123456789ABCDEF";
    int i = 0, j = 0;

    for (i = 0; i < input_len; i++) {
        output[j++] = hexEncode[(input[i] >> 4) & 0xf];
        output[j++] = hexEncode[(input[i]) & 0xf];
    }
    output[j] = 0;
}

#define isDigit(c)             (((c) <= '9' && (c) >= '0') ? (1) : (0))
static uint8_t hex_to_dec(char hex)
{
    if (isDigit(hex)) {
        return (hex - '0');
    }
    if (hex >= 'a' && hex <= 'f') {
        return (hex - 'a' + 10);
    }
    if (hex >= 'A' && hex <= 'F') {
        return (hex - 'A' + 10);
    }
    return 0;
}

/*
    change string to hex array
*/
static int string_to_hex_array(char *input, int input_len, unsigned char *output, int max_len)
{
    int             i = 0;
    uint8_t         ch0, ch1;

    if (input_len % 2 != 0) {
        return -1;
    }

    while (i < input_len / 2 && i < max_len) {
        ch0 = hex_to_dec((char)input[2 * i]);
        ch1 = hex_to_dec((char)input[2 * i + 1]);
        output[i] = (ch0 << 4 | ch1);
        i++;
    }
    return i;
}


/*sha224 crypto */
/*
    SHA224是其中比较常见的一种摘要算法，它的特点就是计算复杂度较低，不等长的数据原文输入，可以得出等长的摘要值，
    这个值是固定为 28 字节。正是由于这种特殊性，很多重要的数据完整性校验领域，都可以看到SHA24的影子，
    不过相对于SHA1/SHA256，SHA224还是用得相对少很多
*/
#if ENABLE_SHA2_224
#define CONFIG_SHA256_SMALLER 1

/*
 * 32-bit int32_teger manipulation macros (big endian)
 */
#ifndef GET_UINT32_BE
#define GET_UINT32_BE(n,b,i)                            \
do {                                                    \
    (n) = ( (uint32_t) (b)[(i)    ] << 24 )             \
        | ( (uint32_t) (b)[(i) + 1] << 16 )             \
        | ( (uint32_t) (b)[(i) + 2] <<  8 )             \
        | ( (uint32_t) (b)[(i) + 3]       );            \
} while( 0 )
#endif

#ifndef PUT_UINT32_BE
#define PUT_UINT32_BE(n,b,i)                            \
do {                                                    \
    (b)[(i)    ] = (uint8_t) ( (n) >> 24 );       \
    (b)[(i) + 1] = (uint8_t) ( (n) >> 16 );       \
    (b)[(i) + 2] = (uint8_t) ( (n) >>  8 );       \
    (b)[(i) + 3] = (uint8_t) ( (n)       );       \
} while( 0 )
#endif

static const uint32_t K_32[] =
{
    0x428A2F98, 0x71374491, 0xB5C0FBCF, 0xE9B5DBA5,
    0x3956C25B, 0x59F111F1, 0x923F82A4, 0xAB1C5ED5,
    0xD807AA98, 0x12835B01, 0x243185BE, 0x550C7DC3,
    0x72BE5D74, 0x80DEB1FE, 0x9BDC06A7, 0xC19BF174,
    0xE49B69C1, 0xEFBE4786, 0x0FC19DC6, 0x240CA1CC,
    0x2DE92C6F, 0x4A7484AA, 0x5CB0A9DC, 0x76F988DA,
    0x983E5152, 0xA831C66D, 0xB00327C8, 0xBF597FC7,
    0xC6E00BF3, 0xD5A79147, 0x06CA6351, 0x14292967,
    0x27B70A85, 0x2E1B2138, 0x4D2C6DFC, 0x53380D13,
    0x650A7354, 0x766A0ABB, 0x81C2C92E, 0x92722C85,
    0xA2BFE8A1, 0xA81A664B, 0xC24B8B70, 0xC76C51A3,
    0xD192E819, 0xD6990624, 0xF40E3585, 0x106AA070,
    0x19A4C116, 0x1E376C08, 0x2748774C, 0x34B0BCB5,
    0x391C0CB3, 0x4ED8AA4A, 0x5B9CCA4F, 0x682E6FF3,
    0x748F82EE, 0x78A5636F, 0x84C87814, 0x8CC70208,
    0x90BEFFFA, 0xA4506CEB, 0xBEF9A3F7, 0xC67178F2,
};

#define SHR_32(x,n) (((x) & 0xFFFFFFFF) >> (n))
#define ROTR32(x,n) (SHR_32(x,n) | ((x) << (32 - (n))))

#define S0_32(x) (ROTR32(x, 7) ^ ROTR32(x,18) ^  SHR_32(x, 3))
#define S1_32(x) (ROTR32(x,17) ^ ROTR32(x,19) ^  SHR_32(x,10))

#define S2_32(x) (ROTR32(x, 2) ^ ROTR32(x,13) ^ ROTR32(x,22))
#define S3_32(x) (ROTR32(x, 6) ^ ROTR32(x,11) ^ ROTR32(x,25))

#define F0_32(x,y,z) (((x) & (y)) | ((z) & ((x) | (y))))
#define F1_32(x,y,z) ((z) ^ ((x) & ((y) ^ (z))))

#define R(t)                                                        \
    (                                                               \
        local.W[t] = S1_32(local.W[(t) -  2]) + local.W[(t) -  7] +    \
                     S0_32(local.W[(t) - 15]) + local.W[(t) - 16]      \
    )

#define P_32(a,b,c,d,e,f,g,h,x,K)                                      \
    do                                                              \
    {                                                               \
        local.temp1 = (h) + S3_32(e) + F1_32((e),(f),(g)) + (K) + (x);    \
        local.temp2 = S2_32(a) + F0_32((a),(b),(c));                      \
        (d) += local.temp1; (h) = local.temp1 + local.temp2;        \
    } while( 0 )

/*
 * SHA-224/256 context setup
 */
void crypto_sha224_sha256_init( sha224_ctx_t *ctx, int32_t is_224 )
{
    ctx->total[0] = 0;
    ctx->total[1] = 0;

    if( is_224 == 0 ) {
        /* SHA-256 */
        ctx->state[0] = 0x6A09E667;
        ctx->state[1] = 0xBB67AE85;
        ctx->state[2] = 0x3C6EF372;
        ctx->state[3] = 0xA54FF53A;
        ctx->state[4] = 0x510E527F;
        ctx->state[5] = 0x9B05688C;
        ctx->state[6] = 0x1F83D9AB;
        ctx->state[7] = 0x5BE0CD19;
    } else {
        /* SHA-224 */
        ctx->state[0] = 0xC1059ED8;
        ctx->state[1] = 0x367CD507;
        ctx->state[2] = 0x3070DD17;
        ctx->state[3] = 0xF70E5939;
        ctx->state[4] = 0xFFC00B31;
        ctx->state[5] = 0x68581511;
        ctx->state[6] = 0x64F98FA7;
        ctx->state[7] = 0xBEFA4FA4;
    }

    ctx->is_224 = is_224;
}

void crypto_sha224_init( sha224_ctx_t *ctx )
{
    memset( ctx, 0, sizeof( sha224_ctx_t ) );

    crypto_sha224_sha256_init(ctx, 1);
}

static int32_t local_sha224_process( sha224_ctx_t *ctx,
                                const uint8_t data[64] )
{
    struct {
        uint32_t temp1, temp2, W[64];
        uint32_t A[8];
    } local;

    uint32_t i;

    for( i = 0; i < 8; i++ ) {
        local.A[i] = ctx->state[i];
    }

#if defined(CONFIG_SHA256_SMALLER)
    for( i = 0; i < 64; i++ ) {
        if( i < 16 ) {
            GET_UINT32_BE( local.W[i], data, 4 * i );
        } else {
            R( i );
        }

        P_32( local.A[0], local.A[1], local.A[2], local.A[3], local.A[4],
           local.A[5], local.A[6], local.A[7], local.W[i], K_32[i] );

        local.temp1 = local.A[7]; local.A[7] = local.A[6];
        local.A[6] = local.A[5]; local.A[5] = local.A[4];
        local.A[4] = local.A[3]; local.A[3] = local.A[2];
        local.A[2] = local.A[1]; local.A[1] = local.A[0];
        local.A[0] = local.temp1;
    }
#else /* CONFIG_SHA256_SMALLER */
    for( i = 0; i < 16; i++ ) {
        GET_UINT32_BE( local.W[i], data, 4 * i );
    }

    for( i = 0; i < 16; i += 8 ) {
        P_32( local.A[0], local.A[1], local.A[2], local.A[3], local.A[4],
           local.A[5], local.A[6], local.A[7], local.W[i+0], K_32[i+0] );
        P_32( local.A[7], local.A[0], local.A[1], local.A[2], local.A[3],
           local.A[4], local.A[5], local.A[6], local.W[i+1], K_32[i+1] );
        P_32( local.A[6], local.A[7], local.A[0], local.A[1], local.A[2],
           local.A[3], local.A[4], local.A[5], local.W[i+2], K_32[i+2] );
        P_32( local.A[5], local.A[6], local.A[7], local.A[0], local.A[1],
           local.A[2], local.A[3], local.A[4], local.W[i+3], K_32[i+3] );
        P_32( local.A[4], local.A[5], local.A[6], local.A[7], local.A[0],
           local.A[1], local.A[2], local.A[3], local.W[i+4], K_32[i+4] );
        P_32( local.A[3], local.A[4], local.A[5], local.A[6], local.A[7],
           local.A[0], local.A[1], local.A[2], local.W[i+5], K_32[i+5] );
        P_32( local.A[2], local.A[3], local.A[4], local.A[5], local.A[6],
           local.A[7], local.A[0], local.A[1], local.W[i+6], K_32[i+6] );
        P_32( local.A[1], local.A[2], local.A[3], local.A[4], local.A[5],
           local.A[6], local.A[7], local.A[0], local.W[i+7], K_32[i+7] );
    }

    for( i = 16; i < 64; i += 8 ) {
        P_32( local.A[0], local.A[1], local.A[2], local.A[3], local.A[4],
           local.A[5], local.A[6], local.A[7], R(i+0), K_32[i+0] );
        P_32( local.A[7], local.A[0], local.A[1], local.A[2], local.A[3],
           local.A[4], local.A[5], local.A[6], R(i+1), K_32[i+1] );
        P_32( local.A[6], local.A[7], local.A[0], local.A[1], local.A[2],
           local.A[3], local.A[4], local.A[5], R(i+2), K_32[i+2] );
        P_32( local.A[5], local.A[6], local.A[7], local.A[0], local.A[1],
           local.A[2], local.A[3], local.A[4], R(i+3), K_32[i+3] );
        P_32( local.A[4], local.A[5], local.A[6], local.A[7], local.A[0],
           local.A[1], local.A[2], local.A[3], R(i+4), K_32[i+4] );
        P_32( local.A[3], local.A[4], local.A[5], local.A[6], local.A[7],
           local.A[0], local.A[1], local.A[2], R(i+5), K_32[i+5] );
        P_32( local.A[2], local.A[3], local.A[4], local.A[5], local.A[6],
           local.A[7], local.A[0], local.A[1], R(i+6), K_32[i+6] );
        P_32( local.A[1], local.A[2], local.A[3], local.A[4], local.A[5],
           local.A[6], local.A[7], local.A[0], R(i+7), K_32[i+7] );
    }
#endif /* CONFIG_SHA256_SMALLER */

    for( i = 0; i < 8; i++ ) {
        ctx->state[i] += local.A[i];
    }

    return( 0 );
}

/*
 * SHA-224 process buffer
 */
void crypto_sha224_update( sha224_ctx_t *ctx,
                               const uint8_t *data,
                               uint32_t ilen )
{
    int32_t ret = -1;
    uint32_t fill;
    uint32_t left;

    left = ctx->total[0] & 0x3F;
    fill = 64 - left;

    ctx->total[0] += (uint32_t) ilen;
    ctx->total[0] &= 0xFFFFFFFF;

    if( ctx->total[0] < (uint32_t) ilen ) {
        ctx->total[1]++;
    }

    if( left && ilen >= fill ) {
        memcpy( (void *) (ctx->buffer + left), data, fill );

        if( ( ret = local_sha224_process( ctx, ctx->buffer ) ) != 0 ) {
            /* error */
        	return;
        }

        data += fill;
        ilen  -= fill;
        left = 0;
    }

    while( ilen >= 64 ) {
        if( ( ret = local_sha224_process( ctx, data ) ) != 0 ) {
            /* error */
        	return;
        }

        data += 64;
        ilen  -= 64;
    }

    if( ilen > 0 ) {
        memcpy( (void *) (ctx->buffer + left), data, ilen );
    }
}

/*
 * SHA-224 final digest
 */
void crypto_sha224_final( sha224_ctx_t *ctx, uint8_t *digest )
{
    int32_t ret = -1;
    uint32_t used;
    uint32_t high, low;

    /*
     * Add padding: 0x80 then 0x00 until 8 bytes remain for the length
     */
    used = ctx->total[0] & 0x3F;

    ctx->buffer[used++] = 0x80;

    if( used <= 56 ) {
        /* Enough room for padding + length in current block */
        memset( ctx->buffer + used, 0, 56 - used );
    } else {
        /* We'll need an extra block */
        memset( ctx->buffer + used, 0, 64 - used );

        if( ( ret = local_sha224_process( ctx, ctx->buffer ) ) != 0 ) {
            /* error */
        	return;
        }

        memset( ctx->buffer, 0, 56 );
    }

    /*
     * Add message length
     */
    high = ( ctx->total[0] >> 29 )
         | ( ctx->total[1] <<  3 );
    low  = ( ctx->total[0] <<  3 );

    PUT_UINT32_BE( high, ctx->buffer, 56 );
    PUT_UINT32_BE( low,  ctx->buffer, 60 );

    if( ( ret = local_sha224_process( ctx, ctx->buffer ) ) != 0 ) {
    	/* error */
        return;
    }

    /*
     * Output final state
     */
    PUT_UINT32_BE( ctx->state[0], digest,  0 );
    PUT_UINT32_BE( ctx->state[1], digest,  4 );
    PUT_UINT32_BE( ctx->state[2], digest,  8 );
    PUT_UINT32_BE( ctx->state[3], digest, 12 );
    PUT_UINT32_BE( ctx->state[4], digest, 16 );
    PUT_UINT32_BE( ctx->state[5], digest, 20 );
    PUT_UINT32_BE( ctx->state[6], digest, 24 );

    if( ctx->is_224 == 0 ) {
        PUT_UINT32_BE( ctx->state[7], digest, 28 );
    }

    //change the hex array to string
    #if DIGEST_IS_STRING  
    uint8_t str[(SHA224_DIGEST_LEN-1)/2];
    memcpy(str,digest,sizeof(str));
    hex_array_to_string(str, sizeof(str), digest);
    #endif
}

#endif  /* ENABLE_SHA2_224 */

/*sha256 crypto */
/*
    SHA256是其中最常见的一种摘要算法，它的特点就是计算复杂度较低，不等长的数据原文输入，可以得出等长的摘要值，
    这个值是固定为 32 字节。正是由于这种特殊性，很多重要的数据完整性校验领域，都可以看到SHA256的影子。
    在一些安全认证中，摘要运算的算法等级至少是大于等于SHA256的安全级别，足以证明SHA256的重要性。
*/
#if ENABLE_SHA2_256
#define ROTLEFT(a,b)    (((a) << (b)) | ((a) >> (32-(b))))
#define ROTRIGHT(a,b)   (((a) >> (b)) | ((a) << (32-(b))))
#define CH(x,y,z)       (((x) & (y)) ^ (~(x) & (z)))
#define MAJ(x,y,z)      (((x) & (y)) ^ ((x) & (z)) ^ ((y) & (z)))
#define EP0(x) 	        (ROTRIGHT(x,2) ^ ROTRIGHT(x,13) ^ ROTRIGHT(x,22))
#define EP1(x)          (ROTRIGHT(x,6) ^ ROTRIGHT(x,11) ^ ROTRIGHT(x,25))
#define SIG0(x)         (ROTRIGHT(x,7) ^ ROTRIGHT(x,18) ^ ((x) >> 3))
#define SIG1(x)         (ROTRIGHT(x,17) ^ ROTRIGHT(x,19) ^ ((x) >> 10))

static const uint32_t k[64] = 
{
	0x428a2f98, 0x71374491, 0xb5c0fbcf, 0xe9b5dba5, 0x3956c25b, 0x59f111f1, 0x923f82a4, 0xab1c5ed5,
	0xd807aa98, 0x12835b01, 0x243185be, 0x550c7dc3, 0x72be5d74, 0x80deb1fe, 0x9bdc06a7, 0xc19bf174,
	0xe49b69c1, 0xefbe4786, 0x0fc19dc6, 0x240ca1cc, 0x2de92c6f, 0x4a7484aa, 0x5cb0a9dc, 0x76f988da,
	0x983e5152, 0xa831c66d, 0xb00327c8, 0xbf597fc7, 0xc6e00bf3, 0xd5a79147, 0x06ca6351, 0x14292967,
	0x27b70a85, 0x2e1b2138, 0x4d2c6dfc, 0x53380d13, 0x650a7354, 0x766a0abb, 0x81c2c92e, 0x92722c85,
	0xa2bfe8a1, 0xa81a664b, 0xc24b8b70, 0xc76c51a3, 0xd192e819, 0xd6990624, 0xf40e3585, 0x106aa070,
	0x19a4c116, 0x1e376c08, 0x2748774c, 0x34b0bcb5, 0x391c0cb3, 0x4ed8aa4a, 0x5b9cca4f, 0x682e6ff3,
	0x748f82ee, 0x78a5636f, 0x84c87814, 0x8cc70208, 0x90befffa, 0xa4506ceb, 0xbef9a3f7, 0xc67178f2,
};

static void local_sha256_transform(sha256_ctx_t *ctx, const uint8_t *data)
{
	uint32_t a, b, c, d, e, f, g, h, i, j, t1, t2, m[64];

	for (i = 0, j = 0; i < 16; ++i, j += 4) {
		m[i] = (data[j] << 24) | (data[j + 1] << 16) | (data[j + 2] << 8) | (data[j + 3]);
	}

	for ( ; i < 64; ++i) {
		m[i] = SIG1(m[i - 2]) + m[i - 7] + SIG0(m[i - 15]) + m[i - 16];
	}

	a = ctx->state[0];
	b = ctx->state[1];
	c = ctx->state[2];
	d = ctx->state[3];
	e = ctx->state[4];
	f = ctx->state[5];
	g = ctx->state[6];
	h = ctx->state[7];

	for (i = 0; i < 64; ++i) {
		t1 = h + EP1(e) + CH(e,f,g) + k[i] + m[i];
		t2 = EP0(a) + MAJ(a,b,c);
		h = g;
		g = f;
		f = e;
		e = d + t1;
		d = c;
		c = b;
		b = a;
		a = t1 + t2;
	}

	ctx->state[0] += a;
	ctx->state[1] += b;
	ctx->state[2] += c;
	ctx->state[3] += d;
	ctx->state[4] += e;
	ctx->state[5] += f;
	ctx->state[6] += g;
	ctx->state[7] += h;
}

void crypto_sha256_init(sha256_ctx_t *ctx)
{
	ctx->data_len = 0;
	ctx->bit_len  = 0;
	ctx->state[0] = 0x6a09e667;
	ctx->state[1] = 0xbb67ae85;
	ctx->state[2] = 0x3c6ef372;
	ctx->state[3] = 0xa54ff53a;
	ctx->state[4] = 0x510e527f;
	ctx->state[5] = 0x9b05688c;
	ctx->state[6] = 0x1f83d9ab;
	ctx->state[7] = 0x5be0cd19;
}

void crypto_sha256_update(sha256_ctx_t *ctx, const uint8_t *data, uint32_t len)
{
	uint32_t i;

	for (i = 0; i < len; ++i) {
		ctx->data[ctx->data_len] = data[i];
		ctx->data_len++;
		if (ctx->data_len == 64) {
			local_sha256_transform(ctx, ctx->data);
			ctx->bit_len += 512;
			ctx->data_len = 0;
		}
	}
}

void crypto_sha256_final(sha256_ctx_t *ctx, uint8_t *digest)
{
	uint32_t i;

	i = ctx->data_len;

	// Pad whatever data is left in the buffer.
	if (ctx->data_len < 56) {
		ctx->data[i++] = 0x80;
		while (i < 56) {
			ctx->data[i++] = 0x00;
		}
	} else {
		ctx->data[i++] = 0x80;
		while (i < 64) {
			ctx->data[i++] = 0x00;
		}
		local_sha256_transform(ctx, ctx->data);
		memset(ctx->data, 0, 56);
	}

	// Append to the padding the total message's length in bits and transform.
	ctx->bit_len += ctx->data_len * 8;
	ctx->data[63] = ctx->bit_len;
	ctx->data[62] = ctx->bit_len >> 8;
	ctx->data[61] = ctx->bit_len >> 16;
	ctx->data[60] = ctx->bit_len >> 24;
	ctx->data[59] = ctx->bit_len >> 32;
	ctx->data[58] = ctx->bit_len >> 40;
	ctx->data[57] = ctx->bit_len >> 48;
	ctx->data[56] = ctx->bit_len >> 56;
	local_sha256_transform(ctx, ctx->data);

	// Since this implementation uses little endian byte ordering and SHA uses big endian,
	// reverse all the bytes when copying the final state to the output digest.
	for (i = 0; i < 4; ++i) {
		digest[i]      = (ctx->state[0] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 4]  = (ctx->state[1] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 8]  = (ctx->state[2] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 12] = (ctx->state[3] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 16] = (ctx->state[4] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 20] = (ctx->state[5] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 24] = (ctx->state[6] >> (24 - i * 8)) & 0x000000ff;
		digest[i + 28] = (ctx->state[7] >> (24 - i * 8)) & 0x000000ff;
	}

    //change the hex array to string
    #if DIGEST_IS_STRING  
    uint8_t str[(SHA256_DIGEST_LEN-1)/2];
    memcpy(str,digest,sizeof(str));
    hex_array_to_string(str, sizeof(str), digest);
    #endif
}

#endif  /* ENABLE_SHA2_256 */

/*sha384 crypto */
/*
    SHA384是其中比较常见的一种摘要算法，它的特点就是计算复杂度较低，不等长的数据原文输入，可以得出等长的摘要值，
    这个值是固定为48字节。正是由于这种特殊性，很多重要的数据完整性校验领域，都可以看到SHAxxx的影子。从复杂度上看，
    它是复杂于SHA256的，但是又比SHA512低一些，所以它的位置相对较尴尬，真正使用的场景比较少
*/
/*sha512 crypto */
/*
    SHA512是其中比较常见的一种摘要算法，它的特点就是计算复杂度较低，不等长的数据原文输入，可以得出等长的摘要值，
    这个值是固定为 64 字节。正是由于这种特殊性，很多重要的数据完整性校验领域，都可以看到SHAxxx的影子。
    由于它的摘要值长度比较长，且相对于其他SHA算法，它的计算复杂度会高些，所以使用场景不算特别多。
*/
#if (ENABLE_SHA2_512) || (ENABLE_SHA2_384)

#if defined(_MSC_VER) || defined(__WATCOMC__)
  #define UL64(x) x##ui64
#else
  #define UL64(x) x##ULL
#endif

#define SHA512_VALIDATE_RET(cond)     	            \
  	do {                                            \
        if( !(cond) )                               \
        {                                           \
            return( -1 );                           \
        }                                           \
    } while( 0 )
#define SHA512_VALIDATE(cond) 			            \
   	do {                                            \
        if( !(cond) )                               \
        {                                           \
            return;                                 \
        }                                           \
    } while( 0 )

/*
 * 64-bit integer manipulation macros (big endian)
 */
#ifndef GET_UINT64_BE
#define GET_UINT64_BE(n,b,i)                   	  \
{                                                 \
    (n) = ( (uint64_t) (b)[(i)    ] << 56 )       \
        | ( (uint64_t) (b)[(i) + 1] << 48 )       \
        | ( (uint64_t) (b)[(i) + 2] << 40 )       \
        | ( (uint64_t) (b)[(i) + 3] << 32 )       \
        | ( (uint64_t) (b)[(i) + 4] << 24 )       \
        | ( (uint64_t) (b)[(i) + 5] << 16 )       \
        | ( (uint64_t) (b)[(i) + 6] <<  8 )       \
        | ( (uint64_t) (b)[(i) + 7]       );      \
}
#endif /* GET_UINT64_BE */

#ifndef PUT_UINT64_BE
#define PUT_UINT64_BE(n,b,i)                            \
{                                                       \
    (b)[(i)    ] = (uint8_t) ( (n) >> 56 );       \
    (b)[(i) + 1] = (uint8_t) ( (n) >> 48 );       \
    (b)[(i) + 2] = (uint8_t) ( (n) >> 40 );       \
    (b)[(i) + 3] = (uint8_t) ( (n) >> 32 );       \
    (b)[(i) + 4] = (uint8_t) ( (n) >> 24 );       \
    (b)[(i) + 5] = (uint8_t) ( (n) >> 16 );       \
    (b)[(i) + 6] = (uint8_t) ( (n) >>  8 );       \
    (b)[(i) + 7] = (uint8_t) ( (n)       );       \
}
#endif /* PUT_UINT64_BE */

/*
 * Round constants
 */
static const uint64_t K[80] =
{
    UL64(0x428A2F98D728AE22),  UL64(0x7137449123EF65CD),
    UL64(0xB5C0FBCFEC4D3B2F),  UL64(0xE9B5DBA58189DBBC),
    UL64(0x3956C25BF348B538),  UL64(0x59F111F1B605D019),
    UL64(0x923F82A4AF194F9B),  UL64(0xAB1C5ED5DA6D8118),
    UL64(0xD807AA98A3030242),  UL64(0x12835B0145706FBE),
    UL64(0x243185BE4EE4B28C),  UL64(0x550C7DC3D5FFB4E2),
    UL64(0x72BE5D74F27B896F),  UL64(0x80DEB1FE3B1696B1),
    UL64(0x9BDC06A725C71235),  UL64(0xC19BF174CF692694),
    UL64(0xE49B69C19EF14AD2),  UL64(0xEFBE4786384F25E3),
    UL64(0x0FC19DC68B8CD5B5),  UL64(0x240CA1CC77AC9C65),
    UL64(0x2DE92C6F592B0275),  UL64(0x4A7484AA6EA6E483),
    UL64(0x5CB0A9DCBD41FBD4),  UL64(0x76F988DA831153B5),
    UL64(0x983E5152EE66DFAB),  UL64(0xA831C66D2DB43210),
    UL64(0xB00327C898FB213F),  UL64(0xBF597FC7BEEF0EE4),
    UL64(0xC6E00BF33DA88FC2),  UL64(0xD5A79147930AA725),
    UL64(0x06CA6351E003826F),  UL64(0x142929670A0E6E70),
    UL64(0x27B70A8546D22FFC),  UL64(0x2E1B21385C26C926),
    UL64(0x4D2C6DFC5AC42AED),  UL64(0x53380D139D95B3DF),
    UL64(0x650A73548BAF63DE),  UL64(0x766A0ABB3C77B2A8),
    UL64(0x81C2C92E47EDAEE6),  UL64(0x92722C851482353B),
    UL64(0xA2BFE8A14CF10364),  UL64(0xA81A664BBC423001),
    UL64(0xC24B8B70D0F89791),  UL64(0xC76C51A30654BE30),
    UL64(0xD192E819D6EF5218),  UL64(0xD69906245565A910),
    UL64(0xF40E35855771202A),  UL64(0x106AA07032BBD1B8),
    UL64(0x19A4C116B8D2D0C8),  UL64(0x1E376C085141AB53),
    UL64(0x2748774CDF8EEB99),  UL64(0x34B0BCB5E19B48A8),
    UL64(0x391C0CB3C5C95A63),  UL64(0x4ED8AA4AE3418ACB),
    UL64(0x5B9CCA4F7763E373),  UL64(0x682E6FF3D6B2B8A3),
    UL64(0x748F82EE5DEFB2FC),  UL64(0x78A5636F43172F60),
    UL64(0x84C87814A1F0AB72),  UL64(0x8CC702081A6439EC),
    UL64(0x90BEFFFA23631E28),  UL64(0xA4506CEBDE82BDE9),
    UL64(0xBEF9A3F7B2C67915),  UL64(0xC67178F2E372532B),
    UL64(0xCA273ECEEA26619C),  UL64(0xD186B8C721C0C207),
    UL64(0xEADA7DD6CDE0EB1E),  UL64(0xF57D4F7FEE6ED178),
    UL64(0x06F067AA72176FBA),  UL64(0x0A637DC5A2C898A6),
    UL64(0x113F9804BEF90DAE),  UL64(0x1B710B35131C471B),
    UL64(0x28DB77F523047D84),  UL64(0x32CAAB7B40C72493),
    UL64(0x3C9EBE0A15C9BEBC),  UL64(0x431D67C49C100D4C),
    UL64(0x4CC5D4BECB3E42B6),  UL64(0x597F299CFC657E2A),
    UL64(0x5FCB6FAB3AD6FAEC),  UL64(0x6C44198C4A475817)
};

void crypto_sha384_sha512_init(sha512_ctx_t *ctx, int32_t is_384)
{
    SHA512_VALIDATE( ctx != NULL );

    memset( ctx, 0, sizeof( sha512_ctx_t ) );

    ctx->total[0] = 0;
    ctx->total[1] = 0;

    if( is_384 == 0 ) {
        /* SHA-512 */
        ctx->state[0] = UL64(0x6A09E667F3BCC908);
        ctx->state[1] = UL64(0xBB67AE8584CAA73B);
        ctx->state[2] = UL64(0x3C6EF372FE94F82B);
        ctx->state[3] = UL64(0xA54FF53A5F1D36F1);
        ctx->state[4] = UL64(0x510E527FADE682D1);
        ctx->state[5] = UL64(0x9B05688C2B3E6C1F);
        ctx->state[6] = UL64(0x1F83D9ABFB41BD6B);
        ctx->state[7] = UL64(0x5BE0CD19137E2179);
    } else {
        /* SHA-384 */
        ctx->state[0] = UL64(0xCBBB9D5DC1059ED8);
        ctx->state[1] = UL64(0x629A292A367CD507);
        ctx->state[2] = UL64(0x9159015A3070DD17);
        ctx->state[3] = UL64(0x152FECD8F70E5939);
        ctx->state[4] = UL64(0x67332667FFC00B31);
        ctx->state[5] = UL64(0x8EB44A8768581511);
        ctx->state[6] = UL64(0xDB0C2E0D64F98FA7);
        ctx->state[7] = UL64(0x47B5481DBEFA4FA4);
    }

    ctx->is_384 = is_384;
}

void crypto_sha512_init( sha512_ctx_t *ctx )
{
	crypto_sha384_sha512_init(ctx, 0);
}

#ifndef SHR
#define  SHR(x,n) (x >> n)
#endif
#define ROTR(x,n) (SHR(x,n) | (x << (64 - n)))

#define S0(x) (ROTR(x, 1) ^ ROTR(x, 8) ^  SHR(x, 7))
#define S1(x) (ROTR(x,19) ^ ROTR(x,61) ^  SHR(x, 6))

#define S2(x) (ROTR(x,28) ^ ROTR(x,34) ^ ROTR(x,39))
#define S3(x) (ROTR(x,14) ^ ROTR(x,18) ^ ROTR(x,41))

#define F0(x,y,z) ((x & y) | (z & (x | y)))
#define F1(x,y,z) (z ^ (x & (y ^ z)))

#define P(a,b,c,d,e,f,g,h,x,K)                  \
{                                               \
    temp1 = h + S3(e) + F1(e,f,g) + K + x;      \
    temp2 = S2(a) + F0(a,b,c);                  \
    d += temp1; h = temp1 + temp2;              \
}

static int32_t local_sha512_process( sha512_ctx_t *ctx,
                                     const uint8_t data[128] )
{
    int32_t i;
    uint64_t temp1, temp2, W[80];
    uint64_t A, B, C, D, E, F, G, H;

    SHA512_VALIDATE_RET( ctx != NULL );
    SHA512_VALIDATE_RET( (const uint8_t *)data != NULL );

    for( i = 0; i < 16; i++ ) {
        GET_UINT64_BE( W[i], data, i << 3 );
    }

    for( ; i < 80; i++ ) {
        W[i] = S1(W[i -  2]) + W[i -  7] +
               S0(W[i - 15]) + W[i - 16];
    }

    A = ctx->state[0];
    B = ctx->state[1];
    C = ctx->state[2];
    D = ctx->state[3];
    E = ctx->state[4];
    F = ctx->state[5];
    G = ctx->state[6];
    H = ctx->state[7];
    i = 0;

    do {
        P( A, B, C, D, E, F, G, H, W[i], K[i] ); i++;
        P( H, A, B, C, D, E, F, G, W[i], K[i] ); i++;
        P( G, H, A, B, C, D, E, F, W[i], K[i] ); i++;
        P( F, G, H, A, B, C, D, E, W[i], K[i] ); i++;
        P( E, F, G, H, A, B, C, D, W[i], K[i] ); i++;
        P( D, E, F, G, H, A, B, C, W[i], K[i] ); i++;
        P( C, D, E, F, G, H, A, B, W[i], K[i] ); i++;
        P( B, C, D, E, F, G, H, A, W[i], K[i] ); i++;
    } while( i < 80 );

    ctx->state[0] += A;
    ctx->state[1] += B;
    ctx->state[2] += C;
    ctx->state[3] += D;
    ctx->state[4] += E;
    ctx->state[5] += F;
    ctx->state[6] += G;
    ctx->state[7] += H;

    return( 0 );
}

/*
 * SHA-512 process buffer
 */
void crypto_sha512_update( sha512_ctx_t *ctx,
                               const uint8_t *data,
                               uint32_t len )
{
    int32_t ret;
    uint32_t fill;
    uint32_t left;

    SHA512_VALIDATE( ctx != NULL );
    SHA512_VALIDATE( len == 0 || data != NULL );

    left = (uint32_t) (ctx->total[0] & 0x7F);
    fill = 128 - left;

    ctx->total[0] += (uint64_t) len;

    if( ctx->total[0] < (uint64_t) len ) {
        ctx->total[1]++;
    }

    if( left && len >= fill ) {
        memcpy( (void *) (ctx->buffer + left), data, fill );

        if( ( ret = local_sha512_process( ctx, ctx->buffer ) ) != 0 ) {
        	/* error */
            return ;
        }

        data += fill;
        len  -= fill;
        left = 0;
    }

    while( len >= 128 ) {
        if( ( ret = local_sha512_process( ctx, data ) ) != 0 ) {
            /* error */
            return ;
        }

        data += 128;
        len  -= 128;
    }

    if( len > 0 ) {
        memcpy( (void *) (ctx->buffer + left), data, len );
    }
}

void crypto_sha384_sha512_final( sha512_ctx_t *ctx, uint8_t *digest )
{
    int32_t ret;
    unsigned used;
    uint64_t high, low;

    SHA512_VALIDATE( ctx != NULL );
    SHA512_VALIDATE( (uint8_t *)digest != NULL );

    /*
     * Add padding: 0x80 then 0x00 until 16 bytes remain for the length
     */
    used = ctx->total[0] & 0x7F;

    ctx->buffer[used++] = 0x80;

    if( used <= 112 ) {
        /* Enough room for padding + length in current block */
        memset( ctx->buffer + used, 0, 112 - used );
    } else {
        /* We'll need an extra block */
        memset( ctx->buffer + used, 0, 128 - used );

        if( ( ret = local_sha512_process( ctx, ctx->buffer ) ) != 0 ) {
            /* error */
            return ;
        }

        memset( ctx->buffer, 0, 112 );
    }

    /*
     * Add message length
     */
    high = ( ctx->total[0] >> 61 )
         | ( ctx->total[1] <<  3 );
    low  = ( ctx->total[0] <<  3 );

    PUT_UINT64_BE( high, ctx->buffer, 112 );
    PUT_UINT64_BE( low,  ctx->buffer, 120 );

    if( ( ret = local_sha512_process( ctx, ctx->buffer ) ) != 0 ) {
     	/* error */
            return ;
    }

    /*
     * Output final state
     */
    PUT_UINT64_BE( ctx->state[0], digest,  0 );
    PUT_UINT64_BE( ctx->state[1], digest,  8 );
    PUT_UINT64_BE( ctx->state[2], digest, 16 );
    PUT_UINT64_BE( ctx->state[3], digest, 24 );
    PUT_UINT64_BE( ctx->state[4], digest, 32 );
    PUT_UINT64_BE( ctx->state[5], digest, 40 );

    if( ctx->is_384 == 0 ) {
        PUT_UINT64_BE( ctx->state[6], digest, 48 );
        PUT_UINT64_BE( ctx->state[7], digest, 56 );
    }
}

/*
 * SHA-512 final digest
 */
void crypto_sha512_final( sha512_ctx_t *ctx, uint8_t *digest )
{
    crypto_sha384_sha512_final(ctx, digest);

    //change the hex array to string
    #if DIGEST_IS_STRING  
    uint8_t str[(SHA512_DIGEST_LEN-1)/2];
    memcpy(str,digest,sizeof(str));
    hex_array_to_string(str, sizeof(str), digest);
    #endif
}

/*
 * SHA-384 process init
 */
void crypto_sha384_init( sha512_ctx_t *ctx )
{
	crypto_sha384_sha512_init(ctx, 1);
}

/*
 * SHA-384 process buffer
 */
void crypto_sha384_update( sha512_ctx_t *ctx,
                               const uint8_t *data,
                               uint32_t len )
{
    crypto_sha512_update(ctx, data, len);
}

/*
 * SHA-384 final digest
 */
void crypto_sha384_final( sha512_ctx_t *ctx,
                               uint8_t *digest )
{
    crypto_sha384_sha512_final(ctx, digest);

    //change the hex array to string
    #if DIGEST_IS_STRING  
    uint8_t str[(SHA384_DIGEST_LEN-1)/2];
    memcpy(str,digest,sizeof(str));
    hex_array_to_string(str, sizeof(str), digest);
    #endif
}

#endif  /* (ENABLE_SHA2_512) || (ENABLE_SHA2_384) */


#if ENABLE_SHA2_224
void sha224_demo()
{
    uint8_t *str = "sha224 crypto test";
    sha224_ctx_t ctx;
    uint8_t sha224_digest[SHA224_DIGEST_LEN];

    crypto_sha224_init(&ctx);
	crypto_sha224_update(&ctx, str, strlen(str));
	crypto_sha224_final(&ctx, sha224_digest);

    printf("digest len: %d\n", SHA224_DIGEST_LEN);
    #if DIGEST_IS_STRING
    printf("sha224 digest: %s\n",sha224_digest);
    #else   /* DIGEST_IS_STRING */
    printf("sha224 digest: ");
    for(int i=0;i<SHA224_DIGEST_LEN;i++)
    {
        printf("%02x", sha224_digest[i]);
    }
    printf("\n");
    #endif  /* DIGEST_IS_STRING */
}
#endif  /* ENABLE_SHA2_224 */

#if ENABLE_SHA2_256
void sha256_demo()
{
    uint8_t *str = "sha256 crypto test";
    sha256_ctx_t ctx;
    uint8_t sha256_digest[SHA256_DIGEST_LEN];

    crypto_sha256_init(&ctx);
	crypto_sha256_update(&ctx, str, strlen(str));
	crypto_sha256_final(&ctx, sha256_digest);

    printf("digest len: %d\n", SHA256_DIGEST_LEN);
    #if DIGEST_IS_STRING
    printf("sha256 digest: %s\n",sha256_digest);
    #else   /* DIGEST_IS_STRING */
    printf("sha256 digest: ");
    for(int i=0;i<SHA256_DIGEST_LEN;i++)
    {
        printf("%02x", sha256_digest[i]);
    }
    printf("\n");
    #endif  /* DIGEST_IS_STRING */
}
#endif  /* ENABLE_SHA2_256 */

#if ENABLE_SHA2_384
void sha384_demo()
{
    uint8_t *str = "sha384 crypto test";
    sha384_ctx_t ctx;
    uint8_t sha384_digest[SHA384_DIGEST_LEN];

    crypto_sha384_init(&ctx);
	crypto_sha384_update(&ctx, str, strlen(str));
	crypto_sha384_final(&ctx, sha384_digest);

    printf("digest len: %d\n", SHA384_DIGEST_LEN);
    #if DIGEST_IS_STRING
    printf("sha384 digest: %s\n",sha384_digest);
    #else   /* DIGEST_IS_STRING */
    printf("sha384 digest: ");
    for(int i=0;i<SHA384_DIGEST_LEN;i++)
    {
        printf("%02x", sha384_digest[i]);
    }
    printf("\n");
    #endif  /* DIGEST_IS_STRING */
}
#endif  /* ENABLE_SHA2_384 */

#if ENABLE_SHA2_512
void sha512_demo()
{
    uint8_t *str = "sha512 crypto test";
    sha512_ctx_t ctx;
    uint8_t sha512_digest[SHA512_DIGEST_LEN];

    crypto_sha512_init(&ctx);
	crypto_sha512_update(&ctx, str, strlen(str));
	crypto_sha512_final(&ctx, sha512_digest);

    printf("digest len: %d\n", SHA512_DIGEST_LEN);
    #if DIGEST_IS_STRING
    printf("sha512 digest: %s\n",sha512_digest);
    #else   /* DIGEST_IS_STRING */
    printf("sha512 digest: ");
    for(int i=0;i<SHA512_DIGEST_LEN;i++)
    {
        printf("%02x", sha512_digest[i]);
    }
    printf("\n");
    #endif  /* DIGEST_IS_STRING */
}
#endif  /* ENABLE_SHA2_512 */

